% figure(1);
% subplot(4,1,1);
% plot(out.x_data.time, out.x_data.signals(1).values,'LineWidth', 2);
% hold on;
% grid on;
% plot(out.x_data.time, out.x_data.signals(2).values);
% subplot(4,1,1); xlabel('x (m)');
% subplot(4,1,2); 
% plot(out.y_data.time, out.y_data.signals(1).values,'LineWidth', 2);
% hold on;
% grid on;
% plot(out.y_data.time, out.y_data.signals(2).values);
% subplot(4,1,2); xlabel('y (m)');
% subplot(4,1,3); 
% plot(out.z_data.time, out.z_data.signals(1).values,'LineWidth', 2);
% hold on;
% grid on;
% plot(out.z_data.time, out.z_data.signals(2).values);
% subplot(4,1,3); xlabel('z (m)');
% subplot(4,1,4); 
% plot(out.yaw_data.time, out.yaw_data.signals(1).values,'LineWidth', 2);
% hold on;
% grid on;
% plot(out.yaw_data.time, out.yaw_data.signals(2).values);
% subplot(4,1,4); xlabel('yaw (rad)');
% 
% figure(2);
% plot3(out.x_data.signals(1).values,out.y_data.signals(1).values,out.z_data.signals(1).values,'LineWidth', 2);
% hold on;
% grid on;
% plot3(out.x_data.signals(2).values,out.y_data.signals(2).values,out.z_data.signals(2).values);
% xlabel('x (m)');ylabel('y (m)');zlabel('z (m)');
figure(3);
subplot(4,1,1);
plot(out.x_error.time,out.x_error.signals.values,'LineWidth',2);
xlabel('Error in X(m)');
grid on;
subplot(4,1,2);
plot(out.y_error.time,out.y_error.signals.values,'LineWidth',2);
xlabel('Error in Y(m)');
grid on;
subplot(4,1,3);
plot(out.z_error.time,out.z_error.signals.values,'LineWidth',2);
xlabel('Error in Z(m)');
grid on;
subplot(4,1,4);
plot(out.yaw_error.time,out.yaw_error.signals.values,'LineWidth',2);
xlabel('Error in Yaw(rad)');
grid on;